07. Complementary Filter Math
Nd787 C4 L04 06 Complementary Filter Math V3
Complementary Filter Math
In the video, you saw the following equation for the estimate \hat{\theta}_t:
\hat{\theta}_t = \frac{\tau}{\tau + T_s} \left( \hat{\theta}_{t-1} + T_s z_{t,\dot{\theta}} \right) + \frac{T_s}{\tau + T_s} z_{t,\theta}
The exact same math applies to \hat{\phi}_t:
\hat{\phi}_t = \frac{\tau}{\tau + T_s} \left( \hat{\phi}_{t-1} + T_s z_{t,\dot{\phi}} \right) + \frac{T_s}{\tau + T_s} z_{t,\phi}